#include "node2d2s.h"
#include "ros/ros.h"
int main(int argc, char **argv)
{
	ros::init(argc, argv, "osqp_control");
	ROS_INFO("INIT SUSCESS");
	auto_ros::control::Node2d2s node_2d2s(30);
	ROS_INFO("NODE INIT");
	while (1)
	{
		node_2d2s.LoopProc();
		ros::spinOnce(); //可用回调函数
		node_2d2s.loop_rate_.sleep();
	}

	return 0;
}